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Abstract of JP2000071190 
PROBLEM TO BE SOLVED: To shorten the 
cycle time and correct dislocations of carried 
workpieces precisely. SOLUTION: Detecting 
elements 1 0 to 1 2 are mounted on a robot 
body 5 of a workpiece transfer robot R to 
detect the positions of two points P1 and P2 
on a longitudinal side and one point P3 on a 
lateral side both on the midway of a workpiece 
2a trajectory while it is transferred by a 
telescopic hand H. Based on the detection 
results, a robot controller 9 computes actual 
dislocations of the workpiece 2a from the 
standard position to thereby correct the 
dislocations of the workpiece 2a during 
carrying by moving the hand H 
correspondingly. The dislocations of the 
workpiece 2a are represented by the angular 
movement and corner travels of the workpiece 
2a. 
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(57) [H^] 

IM&^m 0-1 2tt. 9-7*2Sn;K-y h 

ROa#y Bilcifttt^tu to1Mr&/\y KH± 

y2a <Dmv>m±<D 2^Pl, P 2 <hM^ l 3 

ho- v9ti. 7-^ 2 a^IE^Offl^^il^E^^-^ 

?ijE^^>o 9-? 2 aOfim-rtll*. 7-7 2 a^0te 




1 

- ? ro*g&fw» -9 7 - ? m%-> * 7- a \z is i>t. 
usia^ > k±(c«s$ ntzmmv- ? <d 2 m±izisii& 

mmtfuamz&ifcih Ltz'pts. < 1 1 3 ^co^a^ & 1 d 
iiyis 7 - 9 vmmvtiLmfr <?> com^-ma £ fWftf 

nit ^r*«)Tm)IB7-^oajJM©JSU$rtT-9 £ t Z&m 

[fi*ll 2 ] mjlBtaamSli. huIE 3 £.CD o *> 0 2 ^ 
Offig?TH?If5 2]aroo*.(7) 1 SA^tStiJU boIH3^cd 
o*>CD{t!jcD 1 ^cDffia£mJ|E2 2»T *-coft!jcD 1 

•>Xf A. 

[f**il 3 1 iufB^tB^fSti, 31 1 ^ai^SiH 2 
U 

mfiaai 2 ©«tii#is;ti> mm z &<d •? ^><o^<d i 
m-t&z t*w&t-tz>%mm 1 kib*^- 

Xf A, 

[«*J1 4 ] fjfBffS 1 ro^tb^ 8(4, mflB 3 &,<D o *> 
2 ^.^^ti-enHOlB 2 J2ro^&2A^^ai 
ffiffeSI 2 ©fctfi^Kii, Mia 3 &o> i *><dWh<d 1 ££j|ir 
IB 2 ^co^-f n*^ 1 Zlfrbtklii-?& c: t 
-f <S»#3S3 (3|B«©7-^^vXx^„ 

g<7)*#:$)§^(imj!B^> K±lcif)IB^tii^fSS)§^li 

Buiam i fe xz/mmm z <o&&^&*^mirz> ztzft 

-?«SiMvXxA. 

[fff*iS 6 ] mllSt!! amSli. ifrjfB7- ?SSS2!SISIc 
<fc o r milB 7 - ? jntWtt iz ffitE'P t£<t 

(DO *,(7)^-rn^ 1 3SlClB*©7-^iSJH->X^A„ 
[|**J1 7 ] 'pti < £ 1 *tf>i£S±T-£S-f £ 2 2£ 

v-w&.mi'tiZ&ihL. zo^mm^btizt^ 

- 9 mm&ftlffl Zfi 1 7 - ? v X 7^ A (C Jo l^T, 
H^^IB7-^'as^M^*<*^)-5l>(imIfB/^> KiKiatf <b 
ft. H5IB7-^roffiJM^7ilm)^#t J «4>tc > ituiE^ 
> K±lc«g$ n/-cmifB7- ^ (O 2 2±(cfc(t §'>Vj: < 

1 1 3 &cD&.m.z&ihi- m&$L, 

ffimfc&mZtfmtiiLtz'ptj. <tb3 &<DtiLW.Zb t lz 

huib 7 - 9 ©lESEwffis^ ^ ©ne-ma t mm®-? 

ixmt Sr**rmJlB7-^ wjft&ftJffli^TO c: t ZW®. 
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[0 0 0 1 ] 

[fS^OJSlJ-^&ffitfl?] *%B^t±. 7-?«S£a*--y 
m©7-^«JiM^M^ffl^r^7X8«^7-^W 
«JilM»?rif9^ f£7-?W&g-fft£f$tiiLT!£7 
- ^ W«J2l$iJfP ?r JilE K ?7 o ^ i: «^T* # § 7 - ? MSiM -> 

[0 0 0 2] 

io m&v&m ft*. ^aiDX«*«#7 7.*«^o7 

IKOttiLTffiWA-tr'y H?(CJjXitrtS-a--57-^ttl2lvX 
fi*<*«. 7-^$rMJ^-r-5l^. 7-^JKiMajKy h 

1Xffi5fe©*-by M^roB'T^cDffigJziEStlc-tr -y 

[0 0 0 3] Z<Dtzib, m(i#M¥9 - 1 6 2 2 5 7 
^&«KfB«£nfc3MS«ro«&H^ST-ti. #7X1 

20 m<Dm&i5ft<v&m-f nt^m-rnt *$>&■?*> 2 -^ro 
ffiM-rn ^t^tH-t h &mmth-b >* * 7 - ? n # -y 

[0 0 0 4 ] 

fc«PB8¥9 - 1 6 2 2 5 7-^«KIB*3ftfciiM*K 

30 "f. K±t»tf'E.nfc 2o«Egg|-b>-9-«rffll'>T, 
*7Xlffi^V h^tciES-T-SBUtC #7Xl«iA 

-tr>-9-(7)MU*(C^il^73(S] (YTslSl) coffig-f ft<h 

•r a E^tc # 7 x Mg£>£;&73 [Si rofira-r n 5: mm-f -5 „ 

40 4 A*<fi < t&Z> 1 1> 0 P4S^A<* o /i. 

[0 0 0 5] ifc, «S^a*'.y h#3£fTb-;U±£i£ft 
■T * *&t±»a i 4 * fc * , -Sffig?SIE «r o tc t 

mm&w&T-r * t^o mm&tf$> -> tz. 

[0 0 0 6] *ZX\ *J6^(±, ^*»*raa^i«:Mf* 
co fflarn $r wfii tc ifiE-r •& c t ^ r* # § 7 - ? jss^st 

50 [0 0 0 7] 
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t±. 4^<k <hfc*»&ft±?£Mir3 2 3£W-r<i> r 7- 
?£7-^'tt&;2i^gw^> K±t«au, i7-?©t 

[0 0 0 8] 31 1 ©5£BjjT?ti x |sJB#(^>^< tt,3^ 

[0 0 0 9] SS2 0»i"8tt, SB 1 ©56^(c*Ji>T, MIS 
«m¥SHix BWB 3 &cd i *> co 2 ^ffigSrgjfB 2 a© 

g5rHiii5 2ja©T*.offi<D i 2fr£«iaj-f 

[0 0 1 0] m KDfmx-lt, 2.&£ lja^ft&O l£ 

^rftiiro i ja^^^tU-r-s.toi-ur^^cDrN 7-?<o 
[0 0 11] f 3®^l±, fit 1 ofP^fc^T. mm 

* i wawMifcss 2 ©«aj¥«t 

L, ffj|5® 1 e>m&^mi. Bu!B3^c7)9*.<7)2^lr^ 
dJU iWIBSfl 2 ©&i±S^&t±> 1nFlE3;&0>9*.Wf6<Z> 1 

[0 0 12] cnici^ ^2©5IB3t|SISItc, 9-? 
[0 0 1 3] J!4©»UJWU »3©56WK*Ji''T. fulB 

3^<o-9 T&oftero i ^,$rHuiB2jao-9 *.o^-rn^ 1 a 

[0 0 14] dfttcAO, fZ3<D&Wtmmiz. n-9 

[0 0 1 5] S5©^t±, S& 1 frt>s&4 Ojg^icfc^ 

^MimJiB^v K±KmJlfi|$dm2££^tii!uIfiSt 1 4s 
•fctflBBS 2 fl«-f* c t &&mt?z. 

[0 0 16] ZtHzJ^O, 7-7©*2iSI&±-CSBI* 

[0 0 1 7] S6©«Wi. $ 1 ^^5©»iiO 
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[0 0 18] SP 6 ©SMrefcU SAtr^-^JMR&Sti 
A A-T 1= 7-? ro&gffi jE£tT o - i: * 

[0 0 l 9] ^7©§|Bfl(±. th*<nm&±x*& 
KtfL, K7-?©tfc«-fft*Nl*dJU £©fctti£* 

tcis^r. BulB r 7-^ajiM^g*#*'S^(±BufB^> K 
±K&l:tS>n. MIB^-^ottSJM^TilSfr^^feSSiM* 
MIB^v K±fc«cg£ttfciiirta7-7K> 222±Ki3 

[0020] m7commxi,t^ i-ocnim^za^^ 

<&. 7-^WgllWJ:SSi3l5tifi^-crofi[gfflJESr 

&mmz&fttftsi^t&£xt>, R7-?**«*fc$ 

[0 0 2 1 ] 

i^m^mmmmi kit, mwz%m^x*mn<v$k 
m<oBmiz-z>^xnw-tZo 
30 [0022] ant *mm<o% 1 «x*©Ef.T-*^ 

7-^j»2l->X-r A©«fig4^-ri2-e*)-5. HI 1 Kfc^ 

tl^#7Xlf^©«t©7-; 2®if*^HfrM©7- 

a> KHS:»||**Tftffl*-b-y h 3P^l(Ci|3l^$-yr-i»*> 

[0 0 2 3 ] hR(±. a**v ^ V h 

a — 7 9 <D'%m<F>h tiZ^ a*'y 5 f^lCgHg$ tl 

40 |*6(cSil(-@S$n^T-AR 1 SrlHllES-li-<5. 7 — 
U R 1 |4 7(oJ;-prT-AR 2*&mL, $ "itCT 
-^R2{±tt8l^«fc-3-r^>KH«:JIEi^-r-5. tt6. 

7, 8«#wc±7'-y t^^h tic^-pT^-ti-en^ 
ztizttb izmjze>i£mx'M-&znx^z. m*.a. 
$t\6<K>&®mz£^x$ti7tf2mzfimx>£.®&;i^ m 

itZZtlzj;')^ /n> K HfcllS D&ts-tt-flz, mWt£ 
■ttZZtTPx-gZ. 16 6 . 7. 8 £*ft*'n3fci 

50 «*-J'«riBgLTEHEffiS)SiJffll-f <5 «t 9 L T t> «t 
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l\ — h 5 ti. tffl/-;Ma, 4 b± 

•y h*ft5^&*^fc*aaifl*^te**ii:t-J:o 
T^-tr^y h 1 t *-b«y h 3 fc0>H!tel3tt*/N> KH©«fr 

$46 tfKfltttt&ftT^*. ZCDtztb^ (B]e^5a^lHl 

5±^tt€t±±Tic^t!j-r^c:t^^. <rco±Tffijtc 10 
[0 0 2 4 ] 7-? 2(4, ±i£L/c--£^tt£t>o#7 

[0 0 2 5 ] A-b-yM fltf>9 — ? 2 fc*-tzy V 3 (C^ 

*4*5 fca-fe-y M ^S5Mtc{4a$-yr, 1*6 
-arT/N V KH$r#SLT*-tr*y h 1 lCjffl#i*-tf£o £ ^> 
1^. /n> KH«r*-fe'y h 1 ftlzMAt! &Xt& 6 £±«j£ 20 
-£T/?tM<Z)9 — ? 2 «t'n> KH_btc«S^-^^o ^tf> 

1*6 %&\BlfctH£T^> KH£*S*62-£. £^y h 
1 □^■vh*ft5^Tb-^ 
4a, 4 b^^SCgft^, *-t'y h 3 

£o $4 6 fcfc@IE;&-ti:TV>> KH«r# 

IU *-fe*y h 3F^l(c^A$-^^o $fli6£TI$$ 
£-£T^> KH±tc«{l£n*:9-? 2 ££-fe«y h 3 1*1 
KJRIA-r*. ft*>\ ^vKH^t-v h 1 , ZfrbMft 

[0 0 2 6 ] a4<.y h*#5±tcti. 9-? 2 a^ffiM 

■r n*r*aj+* 3 i 0-1 2#sisnr^ 
[0027] tfcfcfcas 10-12 o^n^nci. 9-? 2 

tBSPl 0. 1 1(4. KHi^KjBSnfcttJB©^- 

i 2(4. «<oa±<oi^ottas:«ai-r*. 

[0 0 2 8 1 «t£U8B 10-12 (0««(4ffl-««-l?* 40 
0. 12 2 (cifx-r^O 1 -^O^digp 1 O0>A-A*8»rffiEI 

[0 0 2 9 ] [22 iz^X, t&tiiSP 1 0 li3Stf;gP 1 0 a 

(P3-S3)-YO = tan0 • (X1-X0) 

tub. z<omL2<ommzmi£irzmM2<Dm&<DR 

(4. 0 = OT^l^§, 



£tt&*±cuK.y h*<*5^@«^n/'c7'7 / r^ h 1 Aiz 
Oai'J — T-fe 1 0 b <hli. 9 — ? 2 a (c^><7)ffi 

a-rn^*i;T*>. ^-r^n^^ra^. ^>kh±ic<s 

V-9-1 0 h <DfamzMfc~t ^KSfc 1 Oa^^CDU— If 
2 a $r^LTg^$n^^{CC±'7-^^ 

itf^tt&flJfflLT. 9-? 2 aO«020fi[I 
P 1 i&lhirZZLtW-eg&o 

[ 0 0 3 0] mmizLX^ Mtllff 1 lt7-?2a©« 
^acoffiaP 2 ^il, tfciUSP 1 214. 9-7 2 a <D 

1 -P 3CDffit±a^.y hn>hD-7 9 KattBStU & 

[ 0 0 3 1 1 12 3(4. 2ffl«>*-rft3&«itft-e*^»'&a> 

(2 3 K&^T. Sag-e^cr?-? 2 b<7)&S(4. GMT 
ft<DftivES^ffirt?*9. 9-? 2 a<7>&H(4. ffiK 

t<D3t&immttezi£&tL, mL 1 £x$au mu i 
^y$4^ l^c 2 vttmi&mw-mt lts^lt^ 

^>o ±aL/tcfc9i:, fcitiSPl 0, 11(4. X$4 

(4. YttliffflcXilCl^^.t^CEl^n^o C 
ffi«-f*i3&<<ct^»^iJtt*tttBSPl 0-1 2 

^thUi^ti-tn^na^s i-s 3-efe*. ttz, hl 

S-fti&ttCtzm&lz&tf&tfi&gfll 0-1 2©*tttfJ 

i^BBg^n/c^^i o. i i o^>^Y^[S]cos§gi 

*f tiWY 1 , Y 2 i:L, X$4±(^BHa^ nfctfcdJSP 

[ 0 0 3 2 ] ffi§-rn^i;^9-7 2aO@ 

t7-^2 a^H^P^^^^fta (X0, 
Y0) i:«r*i6^««(z^l>TUiH3-r^i:. tan0 
= ( (P2-S2) - (Pl-Sl) ) / (Y1-Y2) X*$> *) . HUES 6 (4. 

0 = tan- 1 (((P2-S2)-(Pl-Sl))/ / (Yl-Y2)) 
ttaZ. -15, H^lPSrJi^2L 2OiUSc05Ct±. 
y-YO = tan0 • (x-XO) 
T*#>rK ccOiSKti^i (XI. P3-S3) £ffi£cDT% 

( 1 ) 

* (y-Y0) = (- 1 /tan0) • (x-XO) 
-e*0> <l^B^(4^ (P2-S2. Y2) *&*<D-e^ 



(Y2-Y0) = (- 1 /tan0) • (P2-S2-X0) 



[0 0 3 3 ] c©sc (i) «(2) ttomsL-vaim. 



50 



XO=sin0 • cos0 



(2) 



(-P3+S3+Y2+tan0 • XI + (P2-S2)/t 
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anG) 

YO=Y2 + cos0 ■ (cos0 • (P3-S3-Y2)+sin<9 • (-X1+P2- 
S2» 

X0=(P2-S2) 
Y0= (P3-S3) 

[ 0 0 3 4 ] u<7)j:^aT, nifcae t&nhmao. y 
o)£d<*#$>n&. <r<z)i!teae t&i&aao. yw^c* 

[ 0 0 3 5 ] £<DJfre3\ 7-? 2 a0 3MIti, J$ 
tbSPl 0-1 2 tc<fcoT|5lB#(^ai*ti^^T*. 
fiWE-f * <r £ #-e* £ e 

[ 0 0 3 6 ] 7-7 2a©iM»^^it 

[0 0 3 7 ] $ &tc, 7-7 2 a^«2l34*. «*tfn 
iK«y hW5^l7b-;M a, 4 b±*ffija»»-r-5 

fc>%. /n> KH±lct£diS|5 1 o-i 2 J6mf•<^>n/•c:ii^ 
f;:(;i:7-? 2 a Sr4XlW-r-5iaBu4-e. a**«v h*#5 K 

fcitiSBi o~i 2*<istte>nfe*&^n^(TU-;b4 
a. 4 b±©®T*i-*5^r«sai-r*i:^^-et*o - 

[ 0 0 3 8 ] @ 1 tC^7-?$^>X^/*T? 

l±. 7-7 2 aO|a<^Ja(-2o0^aiSPl 0. l 1S:R 
r«©2±<7> 2^P1, P 2 U tgo^tc: 1 r> 

^t^tBSP 1 2 $rl3ttT«c0S±O 1 3 Z$iihi-&± 

2 -?©*lll»<:HW\ !$<7>2<£> 1 jSk«0)2o 2 jftfr 

h ±jg u /cffig-rn -f £ ct -9 tc l r t cfc i \ 

[ 0 0 3 9 ] SA:. S4 ic^-TJ: 2o©«tbSP2 

o. 2 ncj^-c?-? 2 a^ffig-rn^ai-r^^a 

iaTUt\ K«)2Z±^P 1 lli«as« 

2 0fc<fcoT#fcdJU »<7)2±<7>^P 1 2 i«©2±^) 
&P 1 3 <h£f£ajg|5 2 1 (^ct^T^ai-r^o Z(D&ot£ 
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Miaott, 3^p i i -p i 3&&&zn2><D 

[0 0 4 0] Z<D3&P 1 1 -P 1 3**t>t*3j&P 1 
-P3(i, 7-?2a©2±^-e*0, 3^9*>2 
^i^i2±*S, 3^-9^1 ^*<«t<7>2±^t>«tb 

io i&tji2mw&&-ttia*.\,\ 

[0 0 4 1 ] ±&L/c7-7«i&vX^/*-eii. 
7-7 2 a<D2 2±o>3^*ilS^tb-f £<fc 9(at^ 
7-7 2 a£fff£<00LB*±-CK7-7 2 a ©I« 
*8l»U c©K»Lfcil«om«y^«:fi 1 o-r2 2* 

[0 0 4 2 ] ±$Lfc7-7aW^>X-rAT- 

*<*5±^»»fc^ ^nt3(5g^-r. 7-72 
[El®offi#^i{i0^] 

[Ell] *^(7>||Jte^JET**7---^18iil>X^A 
[HI 2] 1 0^A-A^K®[lT-&£ o 

[S3] 2 2o^-T^^ifift-efe^J#^o r 7--^^ffiS 
[04] 2r?^«ajS»t-J:^T3iSLS:*«)-S«««:^-r 

30 m^<ommi 

1. 3-^-trvh 2, 2a-7-^ 4a, 4b-f 
5-D;-K-y 5a-KS 6 — 8 —ft 9— a 

;*?.y h =3 > h □ — 7 

1 0 - 1 2 -«6aj» 10a-5ytSP 1 Ob-'J-T 

14-7'7v-7h R-7-^fSa^*7 h Rl.R 
2-T-A 

40 



(6) 



ftPR 2 0 0 0 - 7 1 1 9 0 



[HI] [0 2] 




[H3] [0 4] 
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